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Abstract — A deterministic attitude estimation problem for 
a rigid body in an attitude dependent potential field with 
bounded measurement errors is studied. An attitude estimation 
scheme that does not use generalized coordinate representations 
of the attitude is presented here. Assuming that the initial 
attitude, angular velocity and measurement noise lie within 
given ellipsoidal bounds, an uncertainty ellipsoid that bounds 
the attitude and the angular velocity of the rigid body is 
obtained. The center of the uncertainty ellipsoid provides point 
estimates, and its size gives the accuracy of the estimates. The 
point estimates and the uncertainty ellipsoids are propagated 
using a Lie group variational integrator and its linearization, 
respectively. The estimation scheme is optimal in the sense that 
the attitude estimation error and the size of the uncertainty 
ellipsoid is minimized at each measurement instant, and it is 
global since the attitude is represented by a rotation matrix. 

I. Introduction 

Attitude estimation is often a prerequisite for controlling 
aerospace and underwater vehicles, mobile robots, and other 
mechanical systems moving in space. The attitude determi- 
nation problem for a rigid body from vector measurements 
was first posed in [1]. A sample of the literature in attitude 
estimation can be found in [2], [3], [4]. 

Most existing attitude estimation schemes use generalized 
coordinates to represent the attitude. As is well known, 
minimal coordinate representations of the rotation group, like 
Euler angles, Rodrigues parameters, and modified Rodrigues 
parameters, lead to geometric or kinematic singularities. 
Non-minimal coordinate representations, like quaternions 
used in the quaternion estimation (QUEST) algorithm and 
its several variants ([3], [5]), have their own associated 
problems. Besides the extra unit norm constraint one needs 
to impose on the quaternion, the quaternion representation, 
which is diffeomorphic to SU(2), double covers S0(3). As 
such, it has an inevitable ambiguity in expressing the attitude. 

A stochastic state estimator requires probabilistic models 
for the state uncertainty and the noise. However, statistical 
properties of the uncertainty and the noise are often not 
available. We usually make statistical assumptions on dis- 
turbance and noise in order to make the estimation problem 
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mathematically tractable. In many practical situations such 
idealized assumptions are not appropriate, and this may cause 
poor estimation performance [6]. 

An alternative deterministic approach is to specify bounds 
on the uncertainty and the measurement noise without an 
assumption on their distribution. Noise bounds are available 
in many cases, and deterministic estimation is robust to the 
noise distribution. An efficient but flexible way to describe 
the bounds is using ellipsoidal sets, referred to as uncertainty 
ellipsoids. The idea of the deterministic estimation process 
is based on set theory results developed in [7]; optimal 
deterministic estimation problems are studied in [8] and [9] 
using uncertainty ellipsoids. 

In this paper, we study attitude estimation problems for 
the uncontrolled dynamics of a rigid body in an attitude- 
dependent potential field using uncertainty ellipsoids. The 
estimation scheme we present has the following important 
features: (1) the attitude is globally represented by a rotation 
matrix without using coordinates, (2) the deterministic esti- 
mator is distinguished from a Kalman or extended Kalman 
filter, (3) the measurement errors are assumed to be bounded 
but there is no restriction on their distribution, and (4) the 
estimates are optimal in the sense that the size of uncertainty 
is minimized at each estimation step. 

This paper is organized as follows. The attitude deter- 
mination problem from vector observations is introduced in 
Section II. The attitude estimation problem is formulated in 
Section III, and the attitude estimation scheme with angular 
velocity measurements is developed in Section IV. Numerical 
examples are presented in Section V. 

II. Attitude Determination from vector 

OBSERVATIONS 

Attitude of a rigid body is defined as the orientation of 
a body fixed frame with respect to a reference frame. It is 
represented by a rotation matrix that is a 3 x 3 orthogonal 
matrix with determinant 1. Rotation matrices have a group 
structure denoted by SO(3). The group action of SO(3) on 
R 3 transforms a vector represented in the body frame into 
the reference frame. In the attitude estimation problem, we 
measure directions in the body frame to fixed points with 
known directions in the reference frame. The directions in 
the body frame are transformed into the known reference 
directions by pre-multiplying by the rotation matrix defining 
the attitude of the rigid body. The rotation matrix can be 
estimated by minimizing an error between the transformed 
measured directions and the known reference directions. 

We denote the ith known direction vector in the reference 
frame as e ! e § 2 , and the corresponding vector represented 



in the body frame as b l £ S 2 . These direction vectors are 
normalized to have unit lengths. The e 1 and b % vectors are 
related by a rotation matrix R G SO (3) that defines the atti- 
tude of the rigid body; e % = Kb 1 , for all i G {1, 2, • • ■ , m}, 
where m is the number of measurements. 

We assume that b l is measured by sensors in the body 
frame. Let the measured direction vector be b % G § 2 , which 
contains sensor errors, and denote the estimated rotation 
matrix by R G SO (3). The estimation error is given by 
e 1 — Kb 1 . The attitude determination problem consists of 
finding R G SO (3) such that the weighted 2 norm of those 
errors is minimized. 



an J = \^w l {e l - Rb r ) T {e l - Rb l ) 
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subject to R G SO (3), 



where E = [e 1 , • • • , e m ] G 

T»3xm an( j w = diagfw 1 ,- 
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w""\ G K"" ;m is a weight- 
ing factor for each measurement. 

This problem is known as Wahba's problem [1]. The 
original solution of Wahba's problem is given in [10], and 
a solution expressed in terms of quaternions (QUEST) is 
presented in [11]. We use the solution expressed in terms of 
a rotation matrix without using generalized coordinates [12]. 
A necessary and sufficient condition for optimality of (1) is 
given by 



i? = 5iGSO(3), S = S T >0 



(2) 



where L = EWB T G 



p3x3 



is non-singular. The unique 



solution of (2) is obtained by QR factorization of L = Q q Q r 



R 



(3) 



where Q q G SO(3), Q r G K 3x3 is an upper triangular 
matrix, and the symmetric positive definite (principal) square 
root is used. Equation (3) is the unique solution of Wahba's 
problem [12]. 

III. Attitude Estimation Problem formulation 

A. State bounding estimation 

We use deterministic state bounding estimation using el- 
lipsoidal sets, referred to as uncertainty ellipsoids, to describe 
state uncertainty and measurement noise. This deterministic 
estimation procedure has steps similar to those in the Kalman 
filter, and is illustrated in Fig. 1. The left figure shows time 
evolution of an uncertainty ellipsoid, and the right figure 
shows a cross section at a fixed measurement instant. At 
the fcth time step, the state is bounded by an uncertainty 
ellipsoid centered at Xk- This initial ellipsoid is propagated 
through time. Suppose that the state is measured next at the 
(fc+/)th time step, when the predicted uncertainty ellipsoid is 
centered at x{ +l . At this instant, the measurement uncertainty 
ellipsoid is centered at x™ +l . The actual state then lies in the 
intersection of the two ellipsoids. In the estimation process, 
we find a new ellipsoid that contains this intersection, as 




(b) Filtering proce- 
dure 



(a) Propagation of uncertainty ellipsoid 

Fig. 1. Uncertainty ellipsoids 



shown in the right figure. The center of the new ellipsoid, 
Xk+i gives a point estimate of the state at time step k + l, and 
the magnitude of the new uncertainty ellipsoid measures the 
estimation accuracy. The deterministic estimates are optimal 
in the sense that the sizes of the ellipsoids are minimized. 

B. Equations of motion 

We consider estimation of the attitude dynamics of a rigid 
body in the presence of an attitude dependent potential, 
[/(■) : SO(3) h-> M, R G SO(3). Systems that can 
be so modeled include a free rigid body, spacecraft on a 
circular orbit with gravity gradient effects [13], or a 3D 
pendulum [14]. The continuous equations of motion are 



jo + n x jn = m, 

R = RS{n), 



(4) 
(5) 



where J G 



p3x3 



is the moment of inertia matrix of the rigid 



body, £1 G K is the angular velocity of the body expressed 



in the body fixed frame, and S(-) : 
mapping defined by S(x)y = x x y for all x, y G 
The vector M G R 3 is the moment due to the potential, 



5o(3) is a skew 

3 



determined by S(M) = §g R 



nT dU 



or more explicitly, 



M = r\ x v ri + r 2 x v r2 + r 3 x v r3 , 



(6) 



where r^, v ri G M ix3 are the ith row vectors of R and 
respectively. 

General numerical integration methods like the popular 
Runge-Kutta schemes, typically preserve neither first in- 
tegrals nor the characteristics of the configuration space, 
SO(3). In particular, the orthogonal structure of the rotation 
matrices is not preserved numerically. It is often proposed to 
parameterize (5) by Euler angles or quaternions instead of 
integrating (5) directly. However, Euler angles yield only lo- 
cal representations of the attitude and they have singularities. 
Unit quaternions do not exhibit singularities, but they have 
the manifold structure of the three sphere § 3 , and double 
cover SO(3). Consequently, the unit quaternion representing 
the attitude is inevitably ambiguous. In addition, general 
numerical integration methods do not preserve the unit length 



constraint. Therefore, quaternions have the same numerical 
drift problem as rotation matrices. 

Lie group variational integrators preserve the group struc- 
ture without the use of local charts, reprojection, or con- 
straints, they are symplectic and momentum preserving, and 
they exhibit good energy behavior for an exponentially long 
time period. The following Lie group variational integrator 
for the attitude dynamics of a rigid body is presented in [14]: 



hS(jn k + ^M fc ) =F k J d - J d F^, 



fc+1 



Rk+i = RkFk, 
ft. 



Flm k + '^FlMk 



fe+i) 



(7) 
(8) 
(9) 



where Jd G R 3 x 3 is a nonstandard moment of inertia matrix 
defined by J d = ±tr[J]/ 3x3 - J, and F k G SO(3) is the 
relative attitude over an integration step. The constant ft G R 
is the integration step size, and the subscript k denotes the 
fcth integration step. This integrator yields a map (R k , ^k) l— * 
(i? fe+ i,O fc+ i) by solving (7) to obtain F k G SO(3) and 
substituting it into (8) and (9) to obtain -Rfe+i and £l k +i- 

It preserves the orthogonal structure of SO (3) because 
the rotation matrix is updated by a product of two rotation 
matrices in (8). Since this integrator is obtained from a 
discrete variational principle, it is symplectic, momentum 
preserving, and has good energy behavior, properties that 
are characteristic of variational integrators. 

C. Uncertainty Ellipsoid 

An uncertainty ellipsoid in R™ is defined as 

£r»(x,P) = {a; G R" (x - x) T P~ 1 {x - x) < lj , (10) 

where x G R™, and P G K" x ™ is a symmetric positive 
definite matrix. We call x the center of the uncertainty 
ellipsoid, and P is the uncertainty matrix that determines 
the size and the shape of the uncertainty ellipsoid. The size 
of an uncertainty ellipsoid is measured by tr[P] which is the 
sum of the squares of the semi principal axes of the ellipsoid. 

The state evolves in the 6 dimensional tangent bundle, 
TSO(3). We identify TSO(3) with SO(3) x so(3) by left 
trivialization, and we identify so (3) with R 3 by the isomor- 
phism S(-). The uncertainty ellipsoid centered at (R, Cl) G 
TSO(3) is induced from an uncertainty ellipsoid in R 6 ; 



£(R,n,p) = \rgso(3), 





"c" 




sn 



G£ R6 (0 6 ,P)|, 

(11) 



where S{() = logm (r t R) G so(3), SQ = n - Q G R 3 , 
and P G M 6x6 is a symmetric positive definite matrix. An 
element (R, Q) G £ (R, O, P) can be written as 

J R = i? e s(c) , n = ti + sn, 

for some x = [C; Stt\ G R 6 satisfying x T P~ 1 x < 1. 



D. Uncertainty model 

We define the measurement error models for the direction 
vector and for the angular velocity. The measurement error 
is modeled by rotation of the measured direction; 

~^ + S(v i )b i , (12) 

where v l G R 3 is the sensor error, which represents the 
Euler axis of rotation vector from b to b l , and is the 
corresponding rotation angle in radians. The approximation 
is obtained by assuming that the measurement error is small. 
The angular velocity measurement errors are modeled as 



Qk = + v k , 



(13) 



where Vlk G R 3 is the measured angular velocity, and Vk G 
R 3 is an additive error. 

We assume that the initial conditions and the sensor noise 
are bounded by prescribed uncertainty ellipsoids. 

{Ro,n )€£(Ro,n ,P ), (14) 
4 e£ R s(0, Si), (15) 
v k G £r3 (0, Tfe), (16) 

where P G M 6x6 , S l k ,T k G R 3x3 are symmetric positive 
definite matrices that define the shape and the size of the 
uncertainty ellipsoids. 

IV. Attitude Estimation with Attitude and 
Angular Velocity Measurements 

In this section, we develop a deterministic estimator for 
the attitude and the angular velocity of a rigid body assuming 
that both attitude and angular velocity measurements are 
available. The estimator consists of three stages; flow update, 
measurement update, and filtering. The flow update predicts 
the uncertainty ellipsoid in the future. The measurement 
update obtains an uncertainty ellipsoid using new measure- 
ments and the sensor error model. Filtering obtains a new 
uncertainty ellipsoid compatible with the predicted and the 
measured uncertainty ellipsoids. 

The subscript k denotes the fcth discrete index, and the 
superscript i denotes zth directional sensor. The superscripts 
/ and m denote the variables related to the flow update and 
the measurement update, respectively. ~ denotes a measured 
variable, and • denotes an estimated variable. 

A. Flow update 

Suppose that the attitude and the angular momentum at 
the fcth step lie in a given uncertainty ellipsoid 

(R k ,0,k) € £(Rk,£lk, Pk), 

and that new measurements are taken at (k + l)th time step. 
Flow update predicts the center and the uncertainty matrix 
that define the uncertainty ellipsoid at the (k + Z)th step 
using the given uncertainty ellipsoid at the fcth step. Since 
the attitude dynamics is nonlinear, the admissible boundary 
of the state at the (fc + /)th step is not an ellipsoid in general. 



We assume that the uncertainty ellipsoid at the kth step is 
sufficiently small that states in the uncertainty ellipsoid can 
be approximated using the linearized equations of motion. 

Center: For the given center (R k ,fl k ), the center of the 
uncertainty ellipsoid at step (k + l) is {R k+l ,£l k+l ) obtained 
using the discrete equations of motion, (7), (8), and (9): 



hS(jn k + -M fc ) = F k J d - J d F?, 



R 



k+l 



RkFk; 



(17) 
(18) 



m{ +1 = F k T Cl k + -F k M k + -Mfc+i. (19) 

This integrator yields a map (R k , Cl k ) \— > (R k+1 , & k+ i), and 
this process is repeatedly applied to find the center at the 
(k + l)± step, (Rl +l ,ni +l ). 

Uncertainty matrix: At the (k + l)th step, the state is 
represented by perturbations from the center (R k+1 ,&{ +1 ): 

n k+1 = + sn{ +1 , 

for some Cfc+u^k+i e * 3 
le (k + 

Cfe+i)^fe+i e 



The uncertainty matrix at 
the (k + l)th step is obtained by finding a bound on 
Assume that the uncertainty ellipsoid 
at the fcth step is sufficiently small. Then, Cjfe+i'^fe+i ' tre 
represented by the following linear equations in [13] 



J 



aL 



b k+l — A k X k7 

where x k = [( k ; 5Q k ] G R 6 , and A| G M 6x6 can be suitably 
defined. Since (R k ,il k ) G £(R k ,Q. k , P k ), x k G £ R e(0, P k ) 
by the definition of the uncertainty ellipsoid given in (11). 
Then we can show that A* k x k lies in 

A{x k e£ R s (o,4P fe (4) TN 

Thus, the uncertainty matrix at the (k + l)th step is given 
by 

. T 

(20) 



<i = 4^(4) • 



In summary, the uncertainty ellipsoid at the (k + l)ih step is 
computed using (17), (18), (19), and (20) as: 

(R k+l , n k+l ) g s{k{ +v (i{ +v Pl +l ). (2i) 

B. Measurement update 

The measurement update finds an uncertainty ellipsoid in 
the state space using the measurements and sensor error 
models. The measured attitude and the angular velocity 
define the center of the measurement uncertainty ellipsoid, 
and the sensor error models give the uncertainty matrix. 

Center: The center of the uncertainty ellipsoid, 
(Pk+i^T+i) I s obtained from measurements. Let 
the measured directions to the known points be 
B k+i = [fo\---,& m ] G R 3xm . Then, the attitude R r k n +l 
satisfies the following necessary condition given in (2) 



T _ 

Lk+i 



fT Am 
^k+l n k+l 



o. 



(22) 



where L k+l = E k+ iW k+ iBj, +l G R 3X3 . The attitude matrix 
is given by a QR factorization of L k+ i as in (3) 



K 



k+l 



Q q <J {QrQT^Qi )L k+ i 



where Q q G SO(3) is an orthogonal matrix and Q r G 
is a upper triangular matrix satisfying L k+ i = Q q Q r - 
The angular velocity is measured directly by 

^k+l — tok+l- 



(23) 



Sx3 



(24) 



Uncertainty matrix: We represent the actual state at the 
(fc + i)th step as perturbations from the measured center: 



Rk+i 
&k+i 



RT +l e S ^' 



k+l' 



(25) 
(26) 



forcr + *,^r+*e 



l 3 . The uncertainty matrix is obtained by 
finding a bound on Ck+o^k+l- 

We transform the uncertainties in measuring the body 
directions to known fixed points into uncertainties in the 
rotation matrix by (22). Using the error model in (12), the 
actual directions corresponding to B k+ i are given by 



B, 



k+l 



k+l 



SB 



k+h 



(27) 



where 5B k+l = S^b 1 ,- ■ ■ , S(v m )b n 

The actual directions B k+ i and the actual attitude R k+ i at 
the (k + l)th step also satisfy (23); 



R T 



k+i 



Lk+i - Lj +l R k+t — 0, 



where L k+l = E k+ iW k+ iBl +l 



R 3 



x3 



(28) 
Substitute 



(25) and (27) into (28), and use S{x)A + A 1 S{x) = 



S{HA] h 



A} x) for A e 



p3x3 



, x G R , to get: 



tr 



( R T+i) 



Jk+i 



Lk+i 1 cr+i 



in 



We can rewrite the above equation as 



(29) 



where A™^) G 



x3 is defined appropriately. 
The perturbation of the angular velocity Sfl 1 ^ ; is equal to 
the angular velocity measurement error v k+ i, 



^k+l = 

Define x = [C fc m +; ; SSl^ 



vk+i- (30) 
G R 6 . Using (29) and (30), 



x^ +l = Hl J2A^y k+l +H 2 v k+l , 



p6x3 



where H x = [J 3x3 , 3x3 ] T ,iJ 2 = [0 3 x3, hxa] G 
This expresses x™ +l as a linear combination of the sensor 
errors v % and v. Using the measurement uncertainties (15) 



and (16), we can show that the terms in the right hand side of 
the above equation are in the following uncertainty ellipsoids: 

H 2 Vk+i G £r6 (0, H 2 T k+ iH 2) ■ 

Thus, the uncertainty ellipsoid for x™ +l is obtained as the 
vector sum of the above uncertainty ellipsoids. The mea- 
surement update obtains a minimal ellipsoid that contains the 
vector sum of these uncertainty ellipsoids. Using expressions 
for such a minimal ellipsoid given in [8] and [9], we get: 



k+l 




X < 



E 

i=l 



r k+l,R 



k+i,n 



tr 



P 



k+l,R 



(31) 



P 



where 



k+l D k+l 



Pm,i IT A 

k+LR ~ H 1 A , 

p k+i,n = H 2 T k+ iH2 



In summary, the measured uncertainty ellipsoid at the (k + 
l)th step is defined by (23), (24), and (31); 

(R k+ i,fl k+ i) G £(R™ + i, SVu+u p k+ 1)- ( 32 ) 
C. Filtering procedure 

The filtering procedure obtains a new uncertainty ellip- 
soid compatible with both the predicted and the measured 
uncertainty ellipsoids. From (21) and (32), we know that: 

(R k+ i,n k +i) e £{Ri + i^i+vPi + i)f^£{p'k+h^T+hPk+i) 

The intersection of two ellipsoids is not generally an ellip- 
soid, and it is inefficient to describe an irregular subset in 
the multidimensional space numerically. We find a minimal 
uncertainty ellipsoid containing this intersection. We omit 
the subscript (k + I) here for convenience. 

The measurement uncertainty ellipsoid, £(R m , tl m , P m ), 
is identified by its center (R m ,Cl m ), and the uncertainty 
ellipsoid in M 6 : 

(C m ,^ m )e£ K6 (0 6xl ,P m ), (33) 

where S(( m ) = logm ((R m ) T R) G so(3), Sfl m = 

il — O m 6 M 3 . Similarly, the flow uncertainty ellipsoid, 
£(R f , £l f , Pf ), is identified by its center {&,&), and the 
uncertainty ellipsoid in R 6 : 

(C f ,Sn f )G£ R e(0 6xl ,P f ), (34) 

where S'(C / ) = logm (( J R / ) T J R) G so(3), 5& = {l- & e 
K 3 . An element (Rf , G £(R f , £l f , P f ) is given by 

Rf = Rt e s «'\ (35) 

n f = Ci f + sn f . (36) 



Define C" l/ ,<^ m/ G M 3 such that 

Rf = R™e s « mf \ (37) 

n f = n rn + sn mf . (38) 

Thus, ( m t , 5il m f represent the difference between the cen- 
ters of the two ellipsoids. 

Substituting (37), (38) into (35), (36), we obtain 

Rf = R™e s ^e s « f \ 

-RTe^'+rt, (39) 

n f = h m + (sti mf + sn f ^j , (40) 

where we assumed that ( m f , are sufficiently small. 
Thus, the uncertainty ellipsoid obtained by the flow update, 
£(R f , &f, P f ) is identified by the measured (R m , Cl m ) and 
the following uncertainty ellipsoid in R 6 : 



,P f ), 



(41) 



where x m f 



( m f;5il 



mf 



We seek a minimal ellipsoid that contains the intersection: 

£ Re (0 6xl ,P m )f]£ R e(i mf ,P f ) C £r*(x,P), (42) 

where x — [(; Sfo] G K 6 . Using the expression for a min- 
imal ellipsoid containing the intersection of two ellipsoids 
presented in [8], x and P are given by 

x = Lx mf , 

P = (3(q)(I-L)P"\ 

where 

f3{q) = l + q- (x^fiP^Lx^, 
L = P m (P m + q- 1 pf)-\ 

The constant q is chosen to minimize tr[P]. We convert x 
to points in TSO(3) using the common center (R m , Q m ). 
In summary, the uncertainty ellipsoid at (k + l)th step is 

(R k +i, flk+i) G £(R k +i,0.k+i,Pk+i), (43) 

where 

R k+l = R r k n +l e s(i \ Cl k+l = Cl^ + Sfl, P k+ i = P (44) 
D. Properties of the estimator 

The steps outlined above are repeated to get a dynamic 
filter. This attitude estimator has no singularities since the 
attitude is represented by a rotation matrix. Orthogonality 
of the rotation matrix is preserved as it is updated by the 
structure-preserving Lie group variational integrator. This 
estimator can be used for highly nonlinear large angle 
maneuvers of a rigid body. It is also robust to the distribution 
of the sensor noise since we only use ellipsoidal bounds 
on the noise. The measurements need not be periodic, the 
estimation is repeated whenever new measurements become 
available. We can also extend this attitude estimator to the 
case when angular velocity measurements are not available. 
The filtering step is modified to find an intersection of 
the non-degenerate predicted uncertainty ellipsoid and the 
degenerate measurement uncertainty ellipsoid. 



V. Numerical Simulation 

Numerical simulation results are presented for estimation 
of the attitude dynamics of an uncontrolled rigid spacecraft 
in a circular orbit about a large central body, including 
gravity gradient effects. The on orbit spacecraft model is 
given in [13]. 

The mass, length and time dimensions are normalized by 
the spacecraft mass, the maximum length of the spacecraft, 
and the orbital angular velocity, respectively. The inertia 
of the spacecraft is chosen as J = diag[l, 2.8, 2]. The 
maneuver is an arbitrary large attitude change completed in 
a quarter of the orbit. The initial conditions are chosen as 

R = diag[-l, -1, 1], fl Q = [2.316, 0.446, -0.591] rad/s, 
Ro = J 3X 3, S\) = [2.116, 0.546, -0.891] rad/s. 

The corresponding initial estimation errors are ||£o|| = 
180deg, ||£n || = 21.43^ rad/s. Note that the actual 
initial attitude is opposite to the estimated initial attitude. 
The initial uncertainty matrix is given by 



P = 2diag 



7T 2 [1, 1, 1], (-) [1,1,1] 



so that x%P 1 x = 0.7553 < 1. 

We assume that the measurements are available ten times 
per quarter orbit. The measurement noise is assumed to be 
normally distributed with uncertainty matrices given by 



M 7 iio) /3 * 3rad2 < 



7T \ - 



Tfe= l 7 18oJ ^xaradVs 2 . 
We consider two cases. Fig. 2 shows simulation results when 
both the attitude and the angular velocity are measured. Fig. 
3 shows simulation results when angular velocity measure- 
ments are not available. In each figure, the left plot shows 
the attitude and angular velocity estimation errors, and the 
right plot shows the size of the uncertainty ellipsoid. The 
estimation errors and the size of uncertainty decrease rapidly 
after the first measurement. When the angular velocity mea- 
surements are not available, the estimation error for the 
angular velocity converges relatively slowly as seen in Fig. 
3. (a). For both cases, the terminal attitude error, and the 
terminal angular velocity error are less than 0.88 deg, and 
0.04 rad/s, respectively. 

VI. Conclusion 

A deterministic estimator for the attitude dynamics of a 
rigid body in a potential field with bounded measurement er- 
rors is presented. An uncertainty ellipsoid is obtained at each 
estimation step, and the dynamics is propagated using Lie 
group variational integrators. The center of the uncertainty 
ellipsoid is the point estimate, and its size determines the 
accuracy of the estimate. The estimation scheme is optimal in 
the sense that the size of the uncertainty is minimized at each 
estimation step. It is also global and robust to the distribution 
of measurement noise. This estimator can be extended to 
include the effects of process noise and to the case when 
only attitude measurements are available. These extensions 
are not described in this paper. 
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Fig. 2. Estimation with attitude and angular velocity measurement 
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